Path  Generation  Tactics  for  a  UAV 
Following  a  Moving  Target 


Craig  R.  Husby 


A  thesis  submitted  in  partial  fulfillment  of 
the  requirements  for  the  degree  of 

Master  of  Science  in  Aeronautics  and  Astronautics 

University  of  Washington 

2005 


Program  Authorized  to  Offer  Degree:  Aeronautics  and  Astronautics 

DISTRIBUTION  STATEMENT  A 

Approved  for  Public  Release 
Distribution  Unlimited 


’M  0 

I  2005 

REPORT  DOCUMENTATION  PAGE 

Form  Approved 

0MB  No.  0704-0188 

Public  reporting  burden  for  this  collection  of  information  is  estimated  to  average  1  hour  per  response,  including  the  time  for  reviewing  instructions,  searching  existing  data  sources, 
gathering  and  maintaining  the  data  needed,  and  completing  and  reviewing  the  collection  of  Information.  Send  comments  regarding  this  burden  estimate  or  any  other  aspect  of  this 
collection  of  information,  including  suggestions  for  reducing  this  burden,  to  Washington  Headquarters  Services,  Directorate  for  Information  Operations  and  Reports,  1215  Jefferson 
Davis  Highway,  Suite  1204,  Arlington,  VA  22202-4302,  and  to  the  Office  of  Management  and  Budget,  Paperwork  Reduction  Project  (0704-0188),  Washington,  DC  20503. 

1 .  AGENCY  USE  ONLY  fLeave  blank)  2.  REPORT  DATE  3.  REPORT  TYPE  AND  DATES  COVERED 

31. May. 05  THESIS 

4.  TITLE  AND  SUBTITLE 

PATH  GENERATION  TACTICS  FOR  A  UAV  FOLLOWING  A  MOVING  TARGET 

5.  FUNDING  NUMBERS 

6.  AUTHOR(S) 

2D  LT  HUSBY  CRAIG  R 

7.  PERFORMING  ORGANIZATION  NAME(S)  AND  ADDRESS(ES) 

UNIVERSITY  OF  WASHINGTON 

8.  PERFORMING  ORGANIZATION 
REPORT  NUMBER 

CI04-1096 

9.  SPONSORING/MONITORING  AGENCY  NAME(S)  AND  ADDRESS(ES) 

THE  DEPARTMENT  OF  THE  AIR  FORCE 

AFIT/CIA,  BLDG  125 

2950  P  STREET 

WPAFB  OH  45433 

10.  SPONSORING/MONITORING 
AGENCY  REPORT  NUMBER 

11.  SUPPLEMENTARY  NOTES 

12a.  OISTRIBUTION  AVAILABILITY  STATEMENT 

Unlimited  distribution 

In  Accordance  With  AFI  35-205/AFIT  Sup  1 

12b.  DISTRIBUTION  CODE 

1 3.  ABSTRACT  (Maximum  200  words) 

14.  SUBJECT  TERMS 

15.  NUMBER  OF  PAGES 

98 

16.  PRICE  CODE 

17.  SECURITY  CLASSIFICATION 
OF  REPORT 

18.  SECURITY  CLASSIFICATION 
OF  THIS  PAGE 

19.  SECURITY  CLASSIFICATION 
OF  ABSTRACT 

20.  LIMITATION  OF  ABSTRACT 

Standard  Form  298  (Rev.  2-89)  (EG) 

Prescribed  by  ANSI  Std.  239.18 

Designed  using  Perform  Pro,  WHS/DIOR,  Oct  94 


University  of  Washington 


Abstract 

Path  Generation  Tactics  for  a  UAV 
Following  a  Moving  Target 

by  Craig  R.  Husby 

Chair  of  Supervisory  Committee: 

Professor  Rolf  Rysdyk 

Department  of  Aeronautics  and  Astronautics 

There  is  a  need  for  generating  paths  for  a  fixed  wing  aircraft  maneuvering  to  follow  a  target 
moving  at  various  speeds.  In  this  thesis  we  investigate  three  possible  patterns  and  associated 
algorithms  for  an  unmanned  aerial  vehicle  (UAV)  autonomously  following  a  moving  target. 
The  three  patterns  are  a  square  wave  pattern,  a  circular  pattern,  and  a  bow  tie-shaped 
standoff  pattern.  These  patterns  range  in  capability  of  being  able  to  follow  a  target  that 
is  standing  still  up  to  one  that  is  traveling  at  near  UAV  airspeed,  the  best  solution  being 
some  combination  of  patterns  based  on  the  ratio  of  UAV  velocity  to  target  velocity.  The 
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Chapter  1 

INTRODUCTION  AND  MOTIVATION 

Unmanned  Aerial  Vehicles  (UAVs)  represent  the  capability  of  performing  numerous  es¬ 
sential  operations  at  both  lower  cost  and  lower  risk  than  those  of  manned  aircraft.  Currently 
many  UAV  operations,  such  as  target  following,  are  conducted  manually.  One  desired  ad¬ 
vancement  in  the  continual  development  of  UAVs  is  reaching  the  point  where  the  UAV  is 
capable  of  autonomously  following  a  moving  target.  There  are  many  steps  that  need  to  be 
accomplished  to  achieve  such  an  advancement.  For  instance,  target  recognition  is  needed. 
The  UAV’s  computer  needs  to  be  able  to  pick  out  the  object  it  is  following  from  the  images 
it  is  being  fed  by  the  on  board  camera.  Once  that  is  achieved,  it  is  necessary  to  have  a 
method  of  determining  the  target’s  position  and  velocity  (or  relative  position  and  velocity 
with  respect  to  the  UAV)  based  solely  on  those  two-dimensional  images.  Then  the  UAV 
needs  to  be  programmed  to  take  that  data  and  fly  such  that  the  target  remains  in  view  at 
all  times.  In  other  words,  a  trajectory  must  be  determined  that  allows  the  onboard  sensor 
(such  as  a  nose-mounted  camera)  to  keep  the  target  within  its  range. 

A  lot  of  work  has  been  done  on  autonomously  controlling  UAVs  using  waypoints.  For 
this  problem  however,  that  is  not  necessarily  the  best  solution  because  the  future  movements 
of  the  target  are  unknown.  A  better  solution  would  be  one  that  has  an  initial  path  that 
changes  frequently  as  the  position  of  the  target  is  updated. 

The  focus  of  this  paper  is,  having  real-time  data  of  the  targets  position  and  velocity  and 
accurately  knowing  the  UAV’s  position  and  velocity  (presumably  from  GPS),  developing  the 
code  necessary  for  the  UAV  to  follow  the  target  such  that  the  target  remains  in  constant 
view  of  a  nose-mounted  camera  with  limited  motion.  We  looked  at  three  possible  flight 
patterns  for  the  UAV:  a  square  wave,  a  moving  circle,  and  a  moving  bow  tie-shaped  pattern. 
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Simulation  results  are  presented  to  demonstrate  the  effectiveness  of  each  pattern. 

In  order  to  focus  on  controlling  the  flight  path,  we  use  a  preexisting  platform:  the 
Simulink  model  of  the  Aerosonde  UAV,  and  a  preexisting  path-following  algorithm:  the 
Serret-Pi-enet  method  [16],  The  tactical  algorithms  were  designed  to  integrate  with  the 
existing  task-driven  path  generation  algorithms  and  make  use  of  proprietary  inner  loops 
that  expect  a  turn  rate  command.  We  assume  that  some  other  path-planning  algorithm 
already  placed  the  UAV  near  the  target  (for  purposes  of  simulation  we  start  the  UAV  and 
the  target  at  the  same  point  although  this  is  not  necessary).  There  also  exists  the  possibility 
with  each  of  these  patterns  to  add  some  offset  such  that  the  UAV  remains  some  arbitrary 
distance  away  from  the  target  (i.e.  a  quarter  mile  ahead  of  or  behind  the  target).  Another 
simplification  we  make  is  that  the  UAV  has  a  constant  airspeed  of  25m/ s. 

1.1  Related  Work 

There  are  several  other  institutions  conducting  research  in  this  area  of  interest.  In  regards 
to  following  a  target,  Girard,  et.  al.,  in  research  supported  by  the  Office  of  Naval  Research, 
tackled  the  problem  by  using  a  circular  pattern  for  low  speeds  and  then  transitioning  into 
a  sinusoidal  pattern  for  higher  speeds  [7].  We  looked  at  the  sinusoidal  pattern,  created  at 
the  University  of  California,  Berkeley  [10],  in  which  they  vary  the  amplitude  of  the  sinusoid 
in  order  to  adjust  to  the  targets  speed.  With  this  method  they  were  able  to  follow  a  target 
moving  at  the  same  speed  as  the  UAV  down  to  a  ratio  of  the  UAV’s  speed  to  the  target’s 
speed  of  3:1.  For  reasons  of  integration,  and  for  operation  in  windy  environments,  we  feel 
that  this  is  not  the  most  efficient  method  of  accomplishing  the  task  because  it  relies  on  an 
arbitrary  period  T  that  determines  the  path  and  does  not  take  into  account  the  capability 
of  the  UAV  to  fly  the  turns  necessary  to  follow  the  path  generated. 

Other  work  is  being  done  on  how  a  networked  team  of  autonomous  vehicles  can  accom¬ 
plish  more  complex  tasks  or  the  same  tasks  more  efficiently  [15]. 

Research  is  also  being  conducted  on  tracking  the  target  using  video  images.  Currently 
this  technology  can  locate  targets  from  images  using  algorithms  that  recognize  pixel  pat¬ 
terns  [12].  Once  the  target  is  identified  in  one  frame,  a  tracking  algorithm  estimates  the 
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target  trajectory  by  looking  at  multiple  frames  over  time.  Dr.  Boyd,  with  the  Acquisition, 
Querying  and  Prediction  of  Motion  Trajectories  project,  funded  by  IRIS  Precarn  (Canada), 
is  looking  at  trajectory  acquisition  from  video,  storage  and  retrieval  of  trajectories  from  a 
database,  and  predicting  the  future  path  of  an  object  based  on  previously  observed  tra¬ 
jectories  [8].  Other  work  in  this  area  includes  particle  filters  for  moving  cameras  without 
stabilization  [9]  and  the  Joint  Probabilistic  Data  Association  Filter  (JPDAF)  for  tracking 
multiple  targets  with  unreliable  target  identification  [6] . 

1.2  Applications 

The  US  Navy,  US  Marine  Corps,  US  Army,  UK  Royal  Air  Force,  UK  Navy,  and  Japanese 
Coast  Guard  have  all  indicated  to  us  that  they  are  interested  in  the  capability  of  au¬ 
tonomously  tracking  targets  of  interest  [8].  According  to  the  Department  of  Defense,  un¬ 
manned  vehicles,  including  UAVs,  will  be  a  part  of  its  future  combat  systems  [4].  On  the 
civilian  side,  the  US  as  well  as  some  foreign  governments  have  shown  interest  in  this  technol¬ 
ogy  for  non-military  applications  such  as  tracking  fish,  marine  mammals,  and  lifeboats  for 
search  and  rescue  missions  [8].  Tracking  ocean  debris  such  as  fishing  nets  in  the  Northeast 
Pacific  Ocean  would  greatly  benefit  the  environment  since  they  are  a  significant  threat  to 
wildlife  [5]. 
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Chapter  2 

UAV  PLATFORM  AND  PATH  FOLLOWING  STRATEGIES 

The  platform  on  which  we  tested  our  path  designs  is  the  Aerosonde  UAV  (see  Figure  2.1) , 
in  Matlab’s  Simulink  environment  (see  Appendices). 

In  order  to  implement  our  design  it  is  necessary  to  have  a  path  following  system.  We  used 
the  Serret-Prenet  method  [16].  This  requires  the  input  of  k,  Vc,  Vs,  Xm,  and  Xs-  Not  only 
did  we  use  this  for  purposes  of  following  the  path  we  generated,  in  the  case  of  the  circular 
method  and  part  of  the  standoff  method,  we  based  the  path  on  this  technique.  The  purpose 
of  designing  the  system  in  this  manner  was  to  allow  for  its  integration  with  a  path  planning 
system,  specifically  the  Evolution-Based  Cooperative  Planning  System  (ECoPS)  [14]. 


Figure  2.1:  This  is  the  Aerosonde  UAV  which  is  the  aircraft  on  whose  Simulink  model  we 
designed  and  tested  our  flight  patterns  [1] . 
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Figure  2.2:  The  ’Serret-Frenet”  frame  for  a  2D-Path.  The  Serret-Frenet  frame  provides  a 
means  to  ride  along  the  2D  curve  and  illustrate  its  properties  (curvature)  [16]. 


2.1  Serret-Frenet  Method 


Consider  a  frame  along  the  desired  path,  Fs,  with  Xs,  the  unit  vector,  in  the  direction  of 
the  desired  inertial  velocity,  i.e.  tangential  to  the  path,  and  let  yg  be  the  unit  normal  to  the 
path  (see  Figure  2.2).  If  the  direction  of  the  path  is  indicated  as  Xs  (which  is  considered 
the  desired  ‘course’  when  on  the  path)  then 


cos(xs) 

-sin{xs) 

,  and  fs  = 

sin{xs) 

cos{xs) 

(2.1) 


At  any  point  along  the  desired  path,  its  curvature,  k(s),  is  defined  as  k{s)  =  l/r{s),  where 
r(s)  is  the  radius  of  the  path  at  that  point.  The  Serret-Frenet  formulas  in  2D  provide  the 
following  relations. 


ds 

dys 

ds 


—  KX< 


(2.2) 

(2.3) 
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Xs  =  KS 


(2.4) 


Therefore,  consider  a  frame,  Ti,  which  is  rotated  relative  to  the  inertial  frame,  Te,  over  the 
course  angle  x- 


Vl|s  =  s^l 


u 

V 


=  sTi 


Vc 

0 


—  e^lls  T  X  sPl)|i 


=  e^sls  +  sVlls  +  (1W5  X  sPl) 


(2.5) 

(2.6) 


Let  the  relative  course  be  defined  as 


X  =  X-Xs 


(2.7) 


then 


cos(x)  ~sin{x) 
sin{x)  cos{x) 


0 

X5  0 


.(2.8) 


This,  combined  with  the  fact  that  x  =  X  —  Xs)  rn3.y  be  rearranged  into 
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1  -  Kys  0  0 

0  1  0 
K  0  1 


Vs 

\  ^ ) 


( 


\ 


cos(x)  -S2n(x)  0 
sin{^  cos{x)  0 
0  0  1 


^  Vc'^ 
0 

\  X  J 


(2.9) 


Limitation:  Equation  2.9  is  not  usable  when  r/g  =  =  r(s),  i.e.  when  the  vehicle  is  at 

the  center  of  the  instantaneous  circle. 

2.2  Helmsman  Behavior 


The  guidance  law  objective  is  to  converge  x  and  ps  simultaneously  to  zero.  This  may  be 
achieved  by  coupling  the  commanded  angle  of  convergence  and  cross-distance,  i.e.  XciVs), 
(see  Figure  2.3).  According  to  Pettersen  and  Lefeber  [13],  the  behavior  of  a  ‘good  helmsman’ 
follows  an  intercept  course  Xc  that  varies  with  cross  distance  y^,  rather  than  using  sideward 
velocity.  This  is  similar  to  an  aircraft  in  coordinated  flight,  Vb  =  0,  while  considering  bank 
angle  as  the  control  variable. 
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The  helmsman  behavior  can  be  modeled  as  Xc  —  Xc  —  where  Xc  represents  the 

commanded  absolute  course  and  ct(j/s)  is  any  function  satisfying 


VsCriVs)  >  0 

a(0)  =  0 

Vs  ^  [  Xicpt^Xicpt] 

where  Xicpt  represents  the  intercept  angle  at  large  cross  distance.  The  helmsman  behavior 
relative  to  a  straight  line  course  —  0  is 

Xc  =  (2' 10) 


Figure  2.3:  The  behavior  of  a  ’good  helmsman’  modeled  by  the  desired  relative  course  Xd 
as  function  of  cross-distance  yg  in  the  form  of  a  sigmoid  function  (solid  line),  saturating  at 
^Xicpt  •  Xc  ~  0  when  ’close’  to  the  trajectory,  and  saturates  at  Xc  =  ^Xicpt  when  farther 
away.  [16]. 
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In  addition  distinguish: 

•  the  flown  course  x, 

•  the  trajectory  direction  Xs, 

•  the  relative  course  X  —  X  ~  Xs>  and 

•  the  commanded  relative  course  Xc  —  Xc~Xs- 

For  intercepting  and  tracking  a  trajectory,  the  helmsman  behavior  is  relative  to  the 
desired  trajectory.  The  helmsman  behavior  is  expressed  by  formulating  the  commanded 
course  Xc  in  terms  of  Xs  and  yg-  In  that  case,  Equation  2.10  becomes 

Xc  -  Xc-Xs  =  cr(j/s).  (2.11) 

Therefore,  the  helmsman  behavior  in  trajectory  tracking  is 

XciVs^Xs)  =  (^{ys)-\rXs-  (2.12) 

2.3  Convergence  Properties 

Two  aspects  of  the  helmsman  behavior  determine  the  ‘aggressiveness’  of  the  intercept:  the 
maximum  intercept  angle  and  the  ‘lead-distance’  or  slope  da/dyg. 

Assumption  1  Wind  {W,Xw}  are  assumed  known  (estimated). 

Assumption  2  The  airspeed  and  altitude  remain  approximately  constant. 

Assumption  3  Bank  angle  command  following  performs  well  and  fast  relative  to  path- 

changes  of  ±30°. 

Assumption  4  The  commanded  path  will  be  mild  enough  to  prevent  extreme  wind-up 
of  path- following  integrator  due  to  roll-rate  and  saturation  limits.  This  is  a  tempo¬ 
rary  assumption  since  some  form  of  hedging  of  the  commanded  heading  rate  can  be 
implemented  later. 
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Let  the  ideal  course  convergence  dynamics  be  specified  as  follows: 

=Hx,Xc)  (213) 

where  ‘pseudo-control’  i/  refers  to  the  ‘tracking-servo’  control  law  (similar  to  Qc  in  [11]). 
Defined  in  terms  relative  to  the  trajectory  we  would  have 

^  {x  -  Xs}  =  v{x  -  Xs,  Xc  -  Xs) 

j^X  =  v{x,Xc)-  (2.14) 

The  guidance  law  then  is  based  on  desired  tracking  dynamics  by  design  of  the  pseudo 
control  V.  An  example  is  the  tracking  servo  given  in  Reference  [11].  Expressed  in  the  above 
trajectory  parameters, 

V  =  U,  (2.15) 

=  XciVs,  Vc,x)  +  -  [Xc  -  x)  cos(xc  -x)  dT  +  VfJ^Xc  (2.16) 

To  ensure  smooth  and  fast  convergence  in  Reference  [11],  the  signal  xdVst'^CtX)  is  deter¬ 
mined  iteratively,  based  on  relative  location,  orientation,  and  aircraft  bank  performance. 
Therefore,  the  helmsman  behavior  in  Reference  [11]  is  defined  in  terms  of  course  rate-of- 
change  and  is  a  more  sophisticated  version  of  Equation  2.12.  Comparing  Equations  2.11 
and  2.12  with  the  definition  in  Reference  [11]: 

Xc(ys,Vc,x)  =  f2*(ys,^'s)  +  Xs  (2.17) 

=  Xciys,Vs)-\-Xs  (2.18) 

=  Xc{ys,Vc,x)  +  Xs-  (2.19) 

In  this  work  we  consider  the  design: 

I'ix,  Xc)  =  Xc  +  kp{xc  -x)  +  h  f  (Xc  -  X)  dr  (2.20) 

in  terms  of  the  course  relative  to  the  desired  path  Equation  2.14.  This  becomes 

J^(x  -  Xs,  Xc  -  Xs)  =  ixc  -Xs)  +  kpixc  -Xs-X  +  Xs)  +  ki  f  (Xc  -  Xs  -  X  +  Xs)  dr 

J  0 

=  Xc  +  kpixc  -x)  +  ki  [  iXc  -  x)  dr. 


Kx>Xc) 


(2.21) 
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Herein  Xc  —  Xc~Xs  denotes  the  commanded  relative  course  based  on  the  helmsman  behavior, 
Equation  2.12,  displayed  in  Figure  2.3  and  defined  by 

_  g-«ys/2  _  I 

<^{ys)  =  'X.icvt ^_a.ys/2  _|_  {2.22) 


where  a  >  0  is  a  design  variable  such  that  axicpt  represents  the  slope  da/dyg  at  t/s  =  0 
(compare  to  a  derivative  gain).  Therefore,  the  derivative  signal  Xc  is  constructed  as 


(2.23) 

dys 

dt 

(2.24) 

=  <Ty„Vcsm(x) 

(2.25) 

where 

d 

Q-ays/2 

(2.26) 

A 

dys 

<^{ys)  -  "Xtcpt  ^  1)2- 

The  closed  loop  dynamics  according  to  Equation  2.14  then  are 

X  =  (^ys  sin(x)  +  kp(xc  -  x)  +  [  iXc  -  x)  dr. 

Jo 

(2.27) 
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Chapter  3 

SQUARE  WAVE  PATTERN 

Whereas  the  circular  pattern  is  complex  in  its  implementation,  the  square  wave  pat¬ 
tern  was  relatively  straight  forward.  This  pattern  was  inspired  by  the  sinusoidal  method 
developed  by  the  University  of  California,  Berkeley  [10],  We  wanted  to  alter  the  sinusoidal 
pattern  with  the  aim  of  creating  feasible  trajectories  over  a  larger  speed  envelope  and  in 
significant  wind  by  ensuring  that  the  UAV  would  always  be  able  to  fly  the  corners  defined 
by  the  path.  Accomplishing  this  resulted  in  the  square  wave  pattern. 

3.1  Basic  Pattern 

The  pattern  (Figure  3.1)  consists  of  four  straight  segments  and  four  quarter  circles,  defined 
in  Table  3.1.  Once  the  UAV  has  flown  this  pattern,  it  resets  (see  Figure  3.2)  and  repeats 
the  pattern.  Each  time  the  pattern  resets,  the  nominal  lengths  of  segments  a  and  b  are  set 


a 


Figure  3.1:  Basic  unit  of  the  square  wave  pattern 
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Table  3.1:  Segment  definitions  for  the  square  wave  pattern 


Segment 

Description 

Sbl 

straight  segment  with  length  defined  by  velocity  ratio 

Si 

quarter  circle  with  radius  determined  by  turning  capability  (equal  to  S4) 

Sa 

one  of  two  straight  segments  of  equal  length  defined  by  velocity  ratio 

and  feedback 

S2 

quarter  circle  with  radius  determined  by  turning  capability  (equal  to  S3) 

Sb2 

straight  segment  with  length  defined  by  velocity  ratio  and  feedback 

S3 

quarter  circle  with  radius  determined  by  turning  capability  (equal  to  53) 

one  of  two  straight  segments  of  equal  length  defined  by  velocity  ratio 

and  feedback 

54 

quarter  circle  with  radius  determined  by  turning  capability  (equal  to  si) 

reset 


V 

r 

A 

_ 

\ 
_ J 

Figure  3.2:  Location  of  square  wave  reset 


based  on  the  UAV’s  airspeed  and  the  speed 


of  the  target  according  to  Equations  3.1  and  3.2. 


1 


500 

lESTT 

Vt 

500 


^  -  1  >  500 

^  -1  >  1 
Vt  ^  ^  ^ 

^  -  1  <  1 
Vt  ^  ^  ^ 


(3.1) 


f  500 


0 


ii  _  1  >  1 

_  1  <  1 
Vt  ^ 


(3.2) 


These  equations  cause  segment  a  to  increase  in  magnitude  up  to  a  maximum  of  500  (arbi¬ 
trarily  chosen)  as  target  velocity  increases  and  segment  b  to  remain  constant  at  500  until 
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Figure  3.3:  UAV’s  flight  path  when  using  the  square  wave  pattern  to  follow  a  target  with 
varying  speed 


that  point,  when  it  starts  decreasing.  Figure  3.3  shows  the  path  resulting  from  a  target 
changing  speed.  Target  speed  is  used  rather  than  velocity  since  a  coordinate  transforma¬ 
tion  ensures  that  the  a-segments  are  always  parallel  to  the  target’s  velocity  vector  (see 
Section  3.3).  Theoretically,  this  method  would  allow  the  UAV  to  follow  a  target  moving 
with  a  velocity  an3rwhere  from  a  stand  still  up  to  the  velocity  of  the  UAV  by  collapsing  to 
a  nearly  perpendicular  track  or  stretching  to  a  straight  parallel  course.  However,  since  the 
UAV  cannot  make  an  instantaneous  90°  or  180°  turn,  this  is  not  possible. 

The  corners  are  defined  by  the  curvature  k  possible,  defined  by  Equation  3.4.  The 
maximum  bank  angle  used  \s  (j)  —  30°.  This  is  less  than  the  45°  bank  angle  the  UAV  is 
capable  of  in  order  to  better  ensure  the  curvature  is  flyable.  This  robustness  is  necessary 
since  the  velocity  used  for  these  calculations  are  estimated  over  the  whole  segment  as  the 
ground  speed  45°  into  the  turn  (Equations  3.5  and  3.6). 


r  = 


K  = 


K 

gtan<f) 

'vT 


Wy 


=  Va  +  \  W\  COS  ^arctan 

/  Stt 

^2,3  =  K  +  \w\  COS  I  arctan  ^ 


(3.3) 

(3.4) 

(3.5) 

(3.6) 


Because  the  radius  of  the  corners  determines  the  dimensions  of  the  pattern  and  because 
the  wind  determines  the  radius  of  the  corners,  the  target  speed  that  the  UAV  is  capable  of 
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Table  3.2:  Range  of  vehicle  velocity  (m/s)  moving  Eastward,  over  which  the  UAV  is  capable 
of  tracking  the  target  given  an  airspeed  of  25m/s  and  a  wind  speed  of  lOm/s 


Wind  Direction 

0° 

45° 

90° 

135° 

180° 

225° 

270° 

315° 

Min 

3.24 

3.58 

4.36 

5.89 

8.07 

8.40 

6.20 

4.00 

Max 

19.12 

15.52 

13.72 

15.94 

20.96 

25.00 

25.22 

22.59 

Table  3.3:  Range  of  UAV  velocity  to  vehicle  velocity  ratios  over  which  the  UAV  is  capable 
of  tracking  the  target  in  a  lOm/s  wind 


Wind  Direction 

0° 

45° 

0 

O 

135° 

O 

O 

00 

225° 

270° 

315° 

Min 

7.72:1 

6.98:1 

5.73:1 

4.24:1 

3.10:1 

6.26:1 

Max 

1.31:1 

1.61:1 

1.82:1 

1.57:1 

1.19:1 

1.11:1 

following  is  determined  by  the  wind.  Equations  3.7  and  3.8  calculate  what  the  limits  are. 


2ri,4  +  r2,3 

500  ,  ’rri,4  ,  jr7-2,3  ,  500 

V^+Wy  +  Vci.4  ^  U:2,3  Va-Wy 


(3.7) 


^tmax 


1000  j 

Va  +  W^ 


+ 


(3.8) 


where  Wx^y  are  the  wind  components,  the  subscripts  1, 4  and  2, 3  refer  to  the  different  corners 
of  the  pattern  defined  in  Figure  3.1,  and  ri^4or2,3  are  given  by  Equations  3.3  through  3.6. 
With  no  wind  and  a  UAV  speed  of  25m/s,  the  range  is  4.89m/s  to  19.65m/s  or  ratios  5.1:1 
to  1.3:1.  Table  3.2  shows  the  ranges  of  target  speed  possible  for  different  wind  directions 
using  a  wind  speed  of  lOm/s  and  an  Eastward  moving  target.  Table  3.3  shows  the  same 
results  in  terms  of  velocity  ratios. 
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3.2  Feedback 


Also,  each  time  the  pattern  resets,  feedback  is  used  to  compensate  for  any  errors  in  relative 
location.  The  difference  in  x  and  y  directions  are  fed  back  into  a  and  61  according  to 
Equations  3.9  and  3.10.  This  feedback  also  accounts  for  any  coordinate  transformations 
due  to  change  in  target  direction. 


where 


and 


^  [cos(-Axt)Af*;_i  -  sm{-Axt)Mk-i  +  Nk]  (3.9) 

6/  =  -  [cos(-Axt)il4_i  +  sin(-Axt)A^A:-i  +  Mk]  (3.10) 

^Xt  =  Xtk  -  Xtk^^  (3-11) 

f  [-xsin{-Xt)  +  ycos{-Xt)]dt  (3.12) 

Jto 

N  =  Tx-[  [a:cos(-Xt) +  ysin(-xt)]<^i  (3-13) 


subscript  k 

subscript  o 

Tx 

Xt 


refers  to  the  segment  (where  each  segment  is  defined  such  that  xt  is 
constant) 

refers  to  the  start  of  the  current  segment 

is  the  position  of  the  target  in  the  local  x-direction 

is  the  target  heading  —90° 


3.3  Change  in  Target’s  Course 

Each  time  the  target  changes  direction,  the  angle  of  change  of  the  course  is  added  to  the 
heading  Xs  of  the  UAV  and  a  coordinate  transformation  is  done  such  that  the  feedback 
(Equations  3.9  to  3.13)  is  calculated  based  on  the  new  coordinates  as  seen  in  Figure  3.4. 
Figures  3.5  and  3.6  show  this  technique  in  use. 
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Figure  3.6:  UAV’s  flight  pattern  for  a  course  reversal  using  the  square  wave  pattern 


3.4  Resetting 

Resetting  is  accomplished  by  defining  s  (which  determines  location  on  the  pattern)  equal 
to  zero  after  each  complete  pattern  according  to  Equation  3.14  (see  Figure  3.2). 

"I- 

3.5  Advantages  and  Disadvantages 

The  main  advantage  of  this  pattern  is  that  it  is  capable  of  tracking  the  fastest  moving 
target  of  all  the  methods.  As  stated  earlier,  with  no  wind,  this  pattern  can  track  a  target 
with  a  speed  ratio  of  about  1.3:1.  This  is  good  in  and  of  itself,  but  it  could  be  improved 
by  increasing  the  arbitrarily  set  500m  maximum  lengths  of  segments  a  and  b,  although  it 
would  be  a  tradeoff  with  distance  from  the  target. 

This  pattern  also  has  the  benefit  of  being  the  most  simple  method  for  adjusting  the 
position  of  the  UAV  with  respect  to  the  target.  It  is  just  a  matter  of  adjusting  the  magnitude 
of  the  a  and  61  segments. 

The  big  drawback  to  this  method  it  that  it  is  the  only  pattern  that  has  a  lower  limit  to 
the  target  speed  it  is  capable  of  tracking.  This  makes  it  impossible  for  this  method  to  be 
used  by  itself  in  case  the  target  stops  moving.  Another  disadvantage  is  the  complexity  of 
the  feedback  due  to  the  coordinate  transformation  required  for  a  turning  target. 


s  <  Er=i  Si 
s  >  E?=i  Si 


(3.14) 
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Chapter  4 

CIRCULAR  PATTERN 

The  circular  pattern  is  different  in  that  it  is  the  one  method  that  does  not  have  a  defined 
changing  path.  The  UAV  is  simply  directed  to  fly  a  path  of  constant  curvature  and  the 
adjustments  made  for  following  the  target  are  done  purely  by  changes  to  the  Serret-Fl'enet 
variables  ys  and  x-  There  are  two  forms  of  this  pattern.  The  first  we  refer  to  as  the 
’independent’  circular  pattern  and  the  second  as  the  ’integrated’  circular  pattern. 

Note:  Unlike  the  other  two  patterns  where  target  location  is  continually  updated,  for 
the  circular  pattern  we  designed  the  algorithm  such  that  it  updates  the  target  position 
whenever  the  target  has  moved  50m  (a  more  realistic  scenario).  For  this  reason  the  plots 
using  the  circular  pattern  do  not  look  smooth. 

4,1  Independent  Circular  Pattern 

The  simplest  method  of  all  is  the  independent  circular  method.  This  pattern  essentially 
does  not  use  the  Serret-Prenet  method  since  j/s„e„  is  not  fed  back  like  normal  (see  Simulink 
model  in  Appendix  B.3).  Instead,  y*  is  directly  defined  by  Equation  4.1.  Unlike  all  of  the 
other  methods  this  is  constantly  updated  as  opposed  to  being  updated  at  certain  points 
during  the  pattern. 

ys=r-  \/{xt-  xf  +  {y-  ytf  (4.1) 

where  y^  is  limited  by: 

-(r- 1)  <  ys  <  (r- 1).  (4.2) 

The  course  is  still  calculated  using  Equation  4.3  because  this  method  ignores  any  As  (es¬ 
sentially  leaving  out  in  which  direction  the  Ay^  lies). 


X=  SK 


(4.3) 
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Because  of  this,  Us  is  the  only  variable  that  changes  when  the  target  moves,  so  the  algorithm 
just  tells  the  UAV  how  far  it  is  from  the  target  but  not  in  which  direction.  This  greatly  limits 
the  capability  of  this  method.  Empirically  it  can  be  shown  that  it  only  works  accurately 
for  target  speeds  less  than  7m/s  or  a  ratio  of  3.6:1  (these  values  could  be  improved  with 
increased  updates  of  target  location  or  with  an  increased  radius  of  the  pattern,  but  not 
significantly).  Below  this  limit  however,  this  method  is  a  very  simple  solution  to  the  problem 
and  works  well.  Figure  4.1  shows  an  example  of  this  technique.  The  UAV  can  actually  track 
a  target  moving  a  little  faster  than  the  stated  limit  but  the  target  gets  outside  the  circle. 
Another  issue  is  that  it  will  be  strongly  affected  by  wind.  Because  of  this,  like  the  square 
wave  method,  this  pattern  could  never  be  used  by  itself.  These  two  methods  could  however 
be  used  in  combination.  Section  4.4  discusses  the  standard  circular  method  being  combined 
with  the  square  wave  pattern  but  the  same  could  be  done  with  this  method  with  just  a  few 
minor  adjustments. 


Figure  4.1:  The  flight  pattern  of  the  UAV  using  the  independent  circular  method  to  track 
the  target 
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4.2  Basic  Pattern  Movement  of  the  Integrated  Circular  Pattern 

The  integrated  circular  method  can  follow  a  faster  moving  target  with  the  same  radius. 
However,  improving  upon  the  target  speeds  possible  by  the  independent  circular  method 
requires  a  much  more  complex  method.  Figure  4.2  shows  the  geometry  used  to  calculate 
the  changes  needed  to  move  the  circle  with  the  target.  These  values  allow  for  the  calcu¬ 
lations  of  As,  Ays,  and  Ay  needed  to  update  the  Serret-Fi'enet  path  following  algorithm 
(Equation  2.9).  The  distance  from  the  UAV  to  the  new  target  position  is  given  by 


Figure  4.2:  Geometry  used  to  calculate  the  distances  and  angles  necessary  to  move  the 
integrated  circular  pattern  with  the  movement  of  the  target 
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where  the  angle  7  is  defined  by: 


\0-Xt\ 

27r  -  |6>  -  xt\ 


\&-Xt\  <  TT 
\0-Xt\  >  TT 


The  angles  a  and  /?  are  given  by  Equations  4.6  and  4.7. 


TT  —  arcsin  sin  7  j 

{r  +  ysaf 

arcsin  ^  —fr  sin  7^ 

{'<'  +  Vso)^  — 

P=\Tr- 

Xtl 

(4.5) 


(4.6) 

(4.7) 


These  are  used  in  calculating  the  change  in  arclength  position  along  the  desired  path  ac¬ 
cording  to  Equation  4.8. 

As  =  {en-0)r  (4.8) 

where  is  determined  by  the  following  logic. 

if  Xt  >  TT 

if  6-  xt  >  TT 
6n  =  P  o: 
else 

if  6  -Xt>  0 

if  {St-r-  ysjsine  >  0 

On  =  27r  -  \P  -  a\ 
else 

=  1/3  -  a| 

else 

if  Xt  -  6*  >  TT 

if  {St-r-ys^)sme  >  0 
On  =  2^  —  \P  —  a| 
else 

On  =  \P-a\ 

else 


— -  /3  ■+  a 
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else 

if  {St  -  r-y^Jsin^  >  0 
On  =  27r  —  1,S  —  aj 
else 

On  =  1/3  -  a| 

else 

if  0  -  Xt  >  0 

0,j  =  27r  —  /?  —  a 

else 

if  {St~r-  2/5o)sin6>  >  0 
On  =  27r  -  1/3  -  aj 
else 

On  =  \l3-a\ 


The  new  heading  is  then  given  by 

X  =  k(s  +  As).  (4-9) 

The  change  in  normal  distance  from  the  desired  path  is  given  by  Equation  4.10.  This 
is  currently  an  open  issue  since  Ays  is  a  constantly  increasing  number  due  to  the  fact  that 
Ays^  is  added  in  each  time  Ay*-  is  calculated.  Therefore,  more  work  will  need  to  be  done  in 
order  to  keep  this  as  a  finite  value  over  long  periods  of  time. 

Ays  =  Ays^  +  fx  (4.10) 


where 

if  |ys  +  r  -  r|  >  r  -  1 
if  +  r  -  r  >  0 
/X  =  (r  -  1)  -  ys 


else 
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M  =  -(^  -  1)  -  2/s 

else 

=  r  -  r 

and  the  total  added  into  the  Serret-Prenet  operator  is  limited  by: 

-(r-  1)  <  y*  <  (r  -  1). 

4.3  Feedback 

Feedback  for  the  integrated  circle  is  done  at  two  points  around  the  circle  {xs 
=  90°)  simply  by  adjusting  y^  using  Equations  4.12  through  4.14. 

Vsf  —  Vsxf  "h  Vsyj 
Vsxf  =  Vsxf^  +  ^ 

where  u  is  defined  by: 

if  |ys  -  xt  +  X  +  r|  >  r  -  1 
if  y^  -  Xf  +  X  +  r  >  0 
v={r-l)-ys 
else 

v  =  -{r  -  1)  -  y* 


Distance  East  [m] 


(4.11) 

0°  and 

(4.12) 

(4.13) 


Figure  4.3:  UAV’s  flight  pattern  following  a  target  using  the  integrated  circular  pattern 
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else 

jy  =  X  —  Xt  +  r 
and 

ysyf=ysyf^+^  (4.14) 

where  ^  is  defined  by: 

if\Ds~y  +  yt  +  r\>r-l 
if  Vs  -  y  +  yt  +  r  >  0 
^  =  ir-l)-ys 
else 

^  =  -(r  -  1)  -  yg 

else 

^  =  -y  +  yt  +  r 

and  the  initial  value  of  (y  —  yt)  =  r. 

This  feedback  ensures  that  the  target’s  path  is  centered  in  the  circular  pattern  as  seen 
in  Figure  4.3. 

4.4  Simulation 

Because  the  circle  has  infinite  rotational  symmetry,  unlike  the  square  wave  pattern,  no 
coordinate  transformation  is  required  when  the  target  changes  direction.  Course  correction 
is  taken  care  of  in  the  same  manner  that  the  pattern  is  moved  when  it  is  move  in  a  straight 
line.  An  example  of  the  target  changing  direction  is  shown  if  Figure  4.4. 

There  is  no  minimum  speed  for  this  method  and  again  the  maximum  speed  cannot  be 
determined  mathematically.  Empirically  we  determined  the  maximum  target  speed  to  be 
about  Vim/ s  or  a  ratio  of  2.1:1.  This  is  based  on  the  target  position  being  updated  each 
time  it  has  moved  50m  and  the  radius  of  the  integrated  circular  pattern  set  at  150m.  The 
maximum  target  speed  increases  when  the  target  position  is  updated  more  frequently  or 
when  the  radius  of  the  pattern  is  increased.  Figure  4.5  shows  the  case  when  target  position 
is  updated  each  time  it  has  moved  50m  and  the  radius  of  the  circular  pattern  set  at  150m 
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Figure  4.4:  UAV’s  flight  pattern  following  a  turning  target  using  the  integrated  circular 
pattern 


Figure  4.5:  UAV’s  flight  pattern  following  a  target  traveling  at  15m/s  using  the  integrated 
circular  pattern  with  a  radius  of  150m  being  updated  each  time  the  target  has  moved  50m 
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Figure  4.6:  UAV’s  flight  pattern  following  a  target  traveling  at  15m/s  using  the  integrated 
circular  pattern  with  a  radius  of  150m  being  updated  each  time  the  target  has  moved  Im 


Figure  4.7:  UAV’s  flight  pattern  following  a  target  traveling  at  15m/s  using  the  integrated 
circular  pattern  with  a  radius  of  500m  being  updated  each  time  the  target  has  moved  50m 


for  a  target  moving  at  15m/s.  Figure  4.6  shows  what  happens  when  the  target  position 
is  updated  every  meter.  Figure  4.7  shows  the  case  when  the  target  position  is  updated 
every  50m  and  the  radius  of  the  pattern  is  increased  to  500m.  As  can  be  seen,  in  these  last 
two  cases,  the  capability  to  follow  the  target  can  be  improved  but  the  cost  is  either  better 
technology  is  required  or  increased  distance  from  the  target. 

Because  the  square  wave  pattern  has  a  minimum  target  velocity  that  it  can  follow  and 
the  circular  pattern  does  not,  yet  cannot  reach  the  same  maximum  speed  that  the  square 
wave  pattern  can,  it  is  a  logical  conclusion  to  combine  the  two  methods.  This  can  be  done 
through  a  few  simple  modifications  to  the  code.  A  switching  point  based  on  the  ratio  of 
airspeed  to  target  velocity  is  used  with  a  hysteresis  to  avoid  frequent  switching.  Also  the 
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Figure  4.8:  Switching  between  the  integrated  circular  pattern  and  the  square  wave  pattern 


values  of  s  and  ys  must  be  reset  each  time  a  switch  is  made.  Figure  4.8  shows  an  example 
of  the  UAV  switching  back  and  forth  between  the  square  wave  pattern  and  the  integrated 
circular  pattern. 

4.5  Advantages  and  Disadvsintages 

As  the  name  implies,  the  independent  circular  method  has  the  advantage  of  being  extremely 
simple.  This  simplicity  however,  comes  at  the  cost  of  having  a  relatively  low  maximum  speed 
and  more  importantly  getting  completely  off  track  when  the  target  travels  too  fast  for  it  to 
keep  up. 

One  of  the  advantages  of  the  integrated  circular  method  is  that  it  allows  for  longer  time 
between  updates  of  the  target  position  than  the  other  methods  allow.  This  is  because  it 
only  needs  to  keep  the  target  within  its  own  radius  for  it  to  stay  within  view. 
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Another  advantage  is  that  it  has  simpler  feedback  than  square  wave  because  no  coordi¬ 
nate  transformation  is  required  for  changing  course,  although  it  does  work  with  coordinate 
transformation  (as  it  does  when  it  is  combined  with  the  square  wave  method). 

Another  aspect  of  this  method  that  simplifies  it  compared  with  the  others  is  that  it 
has  a  constant  k  (making  the  whole  pattern  equivalent  to  one  segment  of  one  of  the  other 
patterns). 

The  main  disadvantage  of  this  method  is  the  complexity  of  calculating  all  of  the  angles 
required  due  to  the  number  and  size  of  all  of  the  if-then-else  statements  required. 

The  other  drawback  to  this  method  deal  with  the  calculation  of  Ayg.  First,  there  is  the 
limit  that  the  magnitude  of  be  less  than  the  radius  of  the  circle.  This  limits  the  target 
speed  that  this  method  is  capable  of  following.  And  second  is  the  issue  of  the  value  of  Ays 
going  off  to  infinity  as  time  goes  to  infinity,  although  this  is  a  problem  that  should  be  able 
to  be  resolved. 
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Chapter  5 

STANDOFF  PATTERN 

The  main  purpose  of  the  standoff  pattern  is  to  remain  on  one  side  of  the  target,  i.e.  to 
stay  between  the  target  and  the  sun.  It  is  a  more  specialized  pattern  and  therefore  both 
more  complex  and  limited  than  the  other  two  patterns. 

5.1  Basic  Pattern 

The  basic  pattern  is  made  up  of  8  segments  as  seen  in  Figure  5.1  and  described  in  Table  5.1. 
It  is  designed  such  that  segments  4  and  8  are  parallel  to  and  equidistant  from  the  sides  of 


Segment  2 


/ 

Segment  7 


Figure  5.1:  Basic  unit  of  the  standoff  pattern 
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Table  5.1:  Segment  definitions  for  the  standoff  pattern 


Segment 

Description 

Nominal  s  Value 

Si 

Quarter  circle  of  radius  250m  centered 

around  the  upper  right  corner  of  the  target  area 

392.7 

S2 

Straight  segment  of  variable  length 

1 

.  S3 

Half  circle  of  variable  radius 

(nominally  50m) 

157.1 

S4 

Straight  segment  of  variable  length 

101 

S5 

Quarter  circle  of  radius  250m  centered 

around  the  lower  left  corner  of  the  target  area 

392.7 

S6 

Straight  segment  of  variable  length 

1 

S7 

Half  circle  of  variable  radius 

(nominally  50m) 

157.1 

sg 

Straight  segment  of  variable  length 

101 

the  square  target  area  (ideally  with  the  target  at  the  center).  This  is  similar  to  the  standoff 
pattern  already  developed  for  stationary  targets  [17]  but  with  the  addition  of  segments  2 
and  6  to  allow  the  pattern  to  be  more  easily  modified  for  movement.  Each  segment  has  an 
initially  defined  curvature  (k)  and  length  s„. 

K  (and  therefore  s„)  for  segments  3  and  7  vary  depending  on  the  wind  in  order  to  ensure 
that  the  curvature  can  be  flown  by  the  UAV.  We  assume  the  wind  is  such  that  UAV  can 
always  make  a  turn  of  curvature  k  =  1/250  for  segments  1  and  5.  The  lengths  of  segments 
2,  4,  6,  and  8  (the  straight  segments)  vary  to  allow  for  the  changes  in  segments  3  and  7  and 
to  move  the  pattern  with  the  movements  of  the  target. 

K  is  determined  in  the  same  manner  that  it  was  for  the  square  wave  path  (Equation  3.4) 
except  here  we  used  =  40°.  14  is  also  determined  similar  to  Equation  3.5. 

Vc-^  =14  +  \W\  cos  ( arctan  7^  —  tt 


(5.1) 
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Increased 

Diameter 


Figure  5.2;  Basic  unit  of  the  standoff  pattern  in  winds  from  the  North 


Vc2  =  K  +  \W\  cos  ^arctan  ^  “  2  j 

Another  difference  is  that  here  a  limit  is  put  on  k  such  that  k  <  0.02  so  the  radii  of  the 
180°  turns  in  segments  3  and  7  are  never  less  than  50m.  Figure  5.2  shows  an  example  of 
the  changes  made  on  the  basic  pattern  to  account  for  wind  speed. 

The  lengths  of  the  straight  segments  are  determined  by  several  factors.  Segments  2,  4, 
6,  and  8  (which  we  will  also  refer  to  as  segments  a,  b,  c,  and  d  respectively)  each  have  an 
initial  length  that  corresponds  with  the  situation  where  the  target  is  not  moving,  there  is 
no  wind,  and  there  are  no  perturbations  to  the  system.  These  lengths  respectively  are:  Im, 
101m,  Im,  and  101m.  The  reason  for  the  odd  Im  lengths  is  that  the  code  is  unable  to 
handle  a  segment  of  length  zero.  The  next  component  in  the  segment  length  is  the  target’s 
velocity.  To  account  for  this,  the  segments  are  adjusted  by  the  following  equations  (the 
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5.2  Feedback 

To  start  with  we  tried  using  feedback  (like  was  used  in  the  circular  pattern)  at  the  start 
of  segments  1  and  5.  We  determined  that  y*  feedback  worked  better  (or  only  worked)  with 
longer  segments  because  there  are  problems  if  the  UAV  reaches  the  end  of  a  segment  and 
the  value  of  y^  is  still  relatively  large.  Segments  1  and  5  are  the  only  reliably  long  segments 
in  this  pattern  so  we  could  only  use  this  feedback  at  those  two  locations.  The  limitation 
of  this  technique  is  that  the  greatest  y*  feedback  allowed  must  be  less  than  the  radius  of 
the  segment  (in  this  case  it  has  to  be  less  than  the  desired  distance  from  the  target  which 
is  200m  compared  with  the  radius  of  the  segments  which  is  250m).  Because  of  this,  it  is 
greatly  limited  by  speed.  Figure  5.3  shows  this  method  simulated  at  a  slow  enough  speed 
that  the  UAV  can  keep  up  with  the  target.  As  can  be  seen  it  does  a  good  job  of  staying 
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Figure  5.3:  UAV’s  flight  path  when  using  the  standoff  pattern  and  only  using  feedback 
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Figure  5.4:  UAV’s  flight  path  when  using  the  standoff  pattern  and  only  using  abed  feedback 
to  follow  a  target  moving  at  a  relatively  high  velocity  in  a  straight  line 


with  the  target.  However,  because  of  the  significance  of  the  speed  limitation,  we  decided 
that  Ds  feedback  is  not  the  best  option  for  this  pattern  and  used  a  similar  method  to  the  one 
we  used  with  the  square  wave  pattern  by  adjusting  segments  2,  4,  6,  and  8.  This  method 
works  well  and  can  keep  up  with  a  target  moving  at  relatively  high  speeds  (see  Figure  5.4) 
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as  long  as  the  target  is  moving  parallel  to  either  of  the  two  sets  of  straight  segments  in 
the  pattern  (in  the  direction  of  one  of  the  four  compass  points  as  the  pattern  is  drawn  in 
Figure  5.1)  since  those  are  the  directions  that  can  be  changed  by  adjusting  the  segment 
lengths.  It  does  not  work  well  at  all  at  high  speeds  for  target  motion  at  some  angle.  As 
can  be  seen  in  Figure  5.5,  the  UAV  still  tracks  the  target  but  it  is  often  far  from  it  and  in 
many  cases  no  longer  stays  to  one  side  of  the  target.  It  turns  out  that  the  best  method  is  to 
use  a  combination  of  the  ys  feedback  and  this  second  method  (that  we  call  abed  feedback). 
Even  so,  it  is  still  very  limited  by  speed.  Figure  5.6  shows  the  path  of  the  UAV  using  this 
combination  method  of  feedback.  Abed  feedback  is  calculated  using  the  following  equations 
(the  5  in  front  of  each  equation  is  due  to  the  fact  that  the  job  of  feedback  is  split  between 


Figure  5.5:  UAV’s  flight  path  when  trying  to  follow  a  target  moving  at  relatively  high  speed 
and  at  an  angle  with  the  standoff  pattern 
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0 

y  -  yt  -  50 


y  -  yt  -  50  >  0 
y  -  yt  -  50  <  0 


(5.12) 


The  total  segment  lengths  can  now  be  determined.  They  are  given  by  Equations  5.13 
through  5.20 


Si  =  constant 

nr 

~  T 

(5.13) 

7r250 

2 

=  392.699 

S2  =  1  +  az~^  +  a/ 

(5.14) 

n 

S3  =  — 

Kl 

(5.15) 

S4  =  101  T  bz  ^  T  -|-  6^ 

(5.16) 

S5  =  Si 

(5.17) 

S6  =  1  +  cz~^  +  Cf 

(5.18) 

n 

S7  =  — 

K2 

(5.19) 

Sg  —  101  “{"  dz  ^  -f-  dyj 

(5.20) 

where  z  Ms  a  one  time  step  delay.  This  is  needed  in  order  to  avoid  circular  logic  in  the 

calculations  since  the  time  it  takes  for  the  UAV  to  complete  one 

used  to  calculate  a,  b,  c,  and  d  and  is  given  by: 

complete  pattern  (Tp)  is 

II 

(5.21) 

where  n  is  the  number  of  segments  in  the  pattern  and 

Vci  =  Va  +  \W\  cos  ^arctan  ^  -  x* j 

(5.22) 

where  Xi  is  the  target’s  heading  for  the  ith  segment  (the  average  x  for  the  circular  segments) 
and  Si  is  given  by  Equations  5.13  through  5.20. 
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Us  feedback  is  not  involved  in  determining  the  segment  lengths.  It  simply  adjusts  one 
of  the  Serret-Frenet  parameters  to,  in  essence,  tell  the  UAV  that  it  is  off  course  and  thus 
move  the  pattern.  The  value  added  to  the  Serret-Prenet  parameter  is  given  by: 

Aj/s  =  +  Vsf  (5-23) 

where 

Vsf  =  J/sxj.  +  Vsyj  •  (5-24) 

The  two  components  of  this  equation  are  calculated  similarly  (again  the  ^s  in  front  of  some 
of  the  equations  are  due  to  the  fact  that  the  job  of  feedback  is  split  between  the  ys  method 
and  the  Abed  method). 

Vs^j  =  ^  (5-25) 

where 

if  \ys  +  \{y-yt-  200)|  >  Dd-i 
\iys  +  \{y-yt-  200)  >  0 
w  =  {Dd  -l)-ys 
else 

=  -{Dd  -l)-ys 

else 

^  =  ^{y-yt-  200) 

and 

+  \  (5-26) 

where 

if  |ys  +  ^{xt-x-  200)  I  >  Dd  - I 
a  ys  +  ^  {xt  -  X  -  200)  >  0 

\=iDd-l)-  ys 
else 

A  =  -{Dd  -l)-ys 

else 

X  =  ^  {xt  —  X  —  200) 


38 


5.3  Advantages  and  Disadvantages 

The  main  advantage  of  this  pattern  is  its  ability  to  remain  to  one  side  of  the  target.  This 
allows  the  camera  to  get  the  best  pictures  of  the  target  based  on  the  location  of  the  sun. 
It  would  also  keep  an  enemy  target  from  getting  a  good  view  of  the  UAV  if  it  had  to  look 
towards  the  sun  in  order  to  see  it. 

Another  one  of  the  advantages  of  this  pattern,  similar  to  the  circular  pattern,  is  that  no 
coordinate  transformation  is  needed  to  turn  the  pattern.  This  time,  however,  it  is  because 
the  standoff  pattern  is  designed  to  remain  on  one  side  of  the  target  and  therefore  one 
would  not  want  to  rotate  the  pattern.  Because  of  this,  once  again,  no  changes  are  needed 
when  the  target  makes  a  turn,  the  segment  length  calculations  and  the  feedback  methods 
automatically  correct  for  this. 

A  third  advantage  is  that,  again  like  the  circular  pattern,  there  is  no  minimum  speed 
for  this  pattern. 

However,  one  of  the  disadvantages  is  that  this  pattern  has  the  lowest  maximum  speed 
taking  into  account  that  the  target  can  move  in  any  direction  (when  the  target  moves 
parallel  to  either  set  of  straight  segments  in  the  standoff  pattern,  the  maximum  speed  is 
comparable  to  the  maximum  speed  of  the  square  wave  pattern).  A  numerical  maximum 
cannot  be  determined  for  several  reasons.  One  is  that  unlike  the  square  wave  pattern,  in 
this  pattern  there  is  no  limit  put  on  the  length  of  segments  2,  4,  6,  and  8.  Another  is  that 
besides  taking  into  account  the  wind,  like  was  done  in  Table  3.2,  the  target’s  course  would 
also  have  to  be  taken  into  account.  Finally,  like  the  circular  pattern,  feedback  is  used. 
Although  it  can  only  change  at  two  specific  points  in  the  pattern  rather  than  at  any  given 
point  like  in  the  circular  method,  like  with  the  calculations  of  segment  lengths,  its  capability 
of  keeping  the  pattern  moving  with  the  target  depends  so  much  on  the  direction  of  target 
movement.  Empirically,  the  maximum  target  speed  that  this  pattern  is  capable  of  tracking 
is  about  5m/ s  or  a  speed  ratio  of  5:1. 

A  final  disadvantage  is  that  this  is  the  most  complex  pattern.  This  is  not  surprising  since 
it  is  the  most  specialized  pattern.  It  requires  8  defined  segments  and  utilizes  two  types  of 
feedback  whereas  each  of  the  other  two  methods  only  require  one  type  of  feedback. 
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Chapter  6 

CONCLUDING  REMARKS 


6.1  Summary 

There  is  a  need  for  an  autonomous  UAV  to  be  able  to  fly  in  such  a  manner  that  it  can  keep 
a  target  in  view  of  a  nose  mounted  camera.  One  possible  answer  to  this  problem  is  to  have 
preset  patterns  that  the  UAV  can  fly  near  the  target  and  that  will  change  frequently  with 
the  movements  of  the  target. 

The  three  patterns  presented  in  this  thesis  are  possible  solutions  to  this  problem  each 
with  its  own  advantages  and  disadvantages.  All  of  them  have  been  simulated  using  the 
Aerosonde  UAV  model  in  Simulink  and  shown  to  work  under  certain  conditions.  Although 
the  circle  is  the  most  basic  geometric  shape  of  the  three  patterns,  implementing  it  is  actually 
more  complex  than  the  square  wave  pattern  but  it  is  good  at  low  speeds  (down  to  zero)  and 
can  go  faster  than  the  standoff  pattern.  The  independent  circular  pattern  is  very  easy  to 
implement  but  has  the  most  problems  with  a  target  moving  at  higher  speeds.  The  square 
wave  pattern  is  the  most  practical  method  to  implement  and  can  achieve  the  greatest  speeds 
but  it  is  limited  at  lower  speeds  and  cannot  come  to  a  stand  still.  The  standoff  pattern  is 
limited  the  most  in  the  speeds  it  is  capable  of  tracking  but  it  is  still  useful  for  its  purpose 
of  staying  to  one  side  of  the  target.  Some  combination  of  these  methods  (or  similar  ones), 
such  as  the  combination  of  the  square  wave  and  circular  patterns  discussed  in  Chapter  4, 
would  be  the  best  solution  to  the  problem. 

6.2  Future  Work 

The  next  step  that  is  needed  (besides  fixing  the  issue  with  Ays)  is  to  convert  the  Simulink 
models  (shown  in  Appendix  B)  into  C-code  to  be  used  on  an  actual  UAV.  Then  the  camera 
needs  to  be  integrated  such  that  it  ’knows’  in  which  direction  to  point,  based  on  where  in 
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the  patten  the  UAV  currently  is  and  the  last  known  position  and  velocity  of  the  target.  A 
method  of  finding  the  target  will  also  need  to  be  integrated  into  the  algorithm.  This  could 
be  accomplished  with  a  search  pattern.  This  search  pattern  could  also  be  used  in  the  case 
that  the  UAV  loses  sight  of  the  target.  Ultimately,  all  of  this  could  be  used  by  a  group 
of  UAVs  working  together  in  combination  with  an  image  processing  algorithm  to  update 
target  position  and  velocity  using  images  from  onboard  cameras. 
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Appendix  A 

AIRCRAFT  DETAILS 

A.l  Aerodynamic  and  Physical  Parameters  of  the  Aerosonde 

The  following  excerpt  is  from  the  file  aerosondeconf ig.m  which  is  read  by  the  aerosim 
blockset  and  contains  the  aerodynamic  parameters  for  the  Aerosonde  [2]. 

•/•/.•/.  AERODYNAMICS  */.*/.•/. 

*/,  Aerodynamic  force  application  point  (usually  the  aerodynamic  center)  [x  y  z] 
rAC  =  [0.1425  0  0]  ;  */.  m 

Aerodynamic  parameter  bounds  */,*/,*/, 

'/,  Airspeed  bounds 
VaBnd  =  [15  50]  ;  '/.  m/s 
'/,  Sideslip  angle  bounds 
BetaBnd  =  [-0 .5  0.5];  */,  rad 
'/,  Angle  of  attack  bounds 
AlphaBnd  =  [-0.1  0.3];  '/.  rad 

'/.7.'/.  Aerodynamic  reference  parameters  7.7.'/. 

'/,  Mean  aerodynamic  chord 
MAC  =  0.189941;  '/.  m 
7.  Wind  span 
b  =  2.8956;  '/.  m 
'/,  Wing  area 
S  =  0.55;  •/.  m*2 

*/,  ALL  aerodynamics  derivatives  are  per  radicin: 

'/,7.7.  Lift  coefficient  '/.’/,*/, 

'/.  Zero-alpha  lift 
CLO  =  0.23; 

*/,  alpha  derivative 
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CLa  =  5.6106; 

'/,  Lift  control  (flap)  derivative 
CLdf  =  0.74; 

’/.  Pitch  control  (elevator)  derivative 
CLde  =  0.13; 

■/,  alpha-dot  derivative 
CLalphadot  =  1 . 9724 ; 

’/.  Pitch  rate  derivative 
CLq  =  7.9543; 

'/,  Mach  number  derivative 
CLM  =  0; 

Drag  coefficient 
■/.  Lift  at  minimum  drag 
CLmind  =  0.23; 

*/,  Minimum  drag 
CDmin  =  0.0434; 

'/,  Lift  control  (flap)  derivative 
CDdf  =  0.1467; 

'/,  Pitch  control  (elevator)  derivative 
CDde  =  0.0135; 

'/,  Roll  control  (aileron)  derivative 
CDda  =  0.0302; 

’/,  Yaw  control  (rudder)  derivative 
CDdr  =  0.0303; 

’/,  Mach  number  derivative 
CDM  =  0; 

y.  Oswald’s  coefficient 
osw  =  0.75; 

Side  force  coefficient 
’/,  Sideslip  derivative 
CYbeta  =  -0.83; 

'/.  Roll  control  derivative 

CYda  =  -0.075; 

y.  Yaw  control  derivative 


CYdr  =  0.1914; 

•/,  Roll  rate  derivative 
CYp  =  0; 

■/,  Yaw  rate  derivative 
CYr  =  0; 

7X/.  Pitch  moment  coefficient  */,'/,*/, 
'/,  Zero-alpha  pitch 
CmO  =  0.135; 

7,  alpha  derivative 
Cma  =  -2.7397; 

7.  Lift  control  derivative 
Cmdf  =  0.0467; 

7.  Pitch  control  derivative 
Cmde  =  -0.9918; 

7.  alpha.dot  derivative 
Cmalphadot  =  -10.3796; 

7.  Pitch  rate  derivative 
Cmq  =  -38.2067; 

7.  Mach  niimber  derivative 
CmM  =  0; 

7.7.7.  Roll  moment  coefficient  7.7.7. 

7.  Sideslip  derivative 
Clbeta  =  -0.13; 

7.  Roll  control  derivative 
Clda  =  -0.1695; 

7.  Yaw  control  derivative 
Cldr  =  0.0024; 

7.  Roll  rate  derivative 
Clp  =  -0.5051; 

7.  Yaw  rate  derivative 
Clr  =  0.2519; 

7.7.7.  Yaw  moment  coefficient  7.7.7. 

7.  Sideslip  derivative 
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Cnbeta  =  0.0726; 

*/,  Roll  control  derivative 
Cnda  =  0.0108; 

*/.  Yaw  control  derivative 
Cndr  =  -0.0693; 

’/,  Roll  rate  derivative 
Cnp  =  -0.0,69; 

*/,  Yaw  rate  derivative 
Cnr  =  -0.0946; 

W,  PROPELLER 

'/.Propulsion  force  application  point  (usually  propeller  hub)  [x  y  z] 
rHub  =  [0  0  0];  '/.  m 
*/.  Advance  ratio  vector 

J  =  [-10  0.1  0.2  0.3  0.35  0.4  0.45  0.5  0.6  0.7  0.8  0.9  1  1.2  2]; 

'/,  Coefficient  of  thrust  look-up  table  CT  =  CT(J) 

CT  =  [0.0492  0.0286  0.0266  0.0232  0.0343  0.034  0.0372  0.0314  ... 

0.0254  0.0117  -0.005  -0.0156  -0.0203  -0.0295  -0.04  -0.1115]; 

'/,  Coefficient  of  power  look-up  table  CP  =  CP(J) 

CP  =  [0.0199  0.0207  0.0191  0.0169  0.0217  0.0223  0.0254  0.0235  ... 

0.0212  0.0146  0.0038  -0.005  -0.0097  -0.018  -0.0273  -0.0737]; 

’/,  Propeller  radius 
Rprop  =  0.254;  */.  m 
'/.  Propeller  moment  of  inertia 
Jprop  =  0.002;  '/.  kg*m"2 


ENGINE  •/.*/.'/. 

’/,  Engine  rpm  vector 

RPM  =  [1500  2100  2800  3500  4500  5100  5500  6000  7000]  ;  '/.  rot  per  min 

*/.  Manifold  pressure  vector 

MAP  =  [60  70  80  90  92  94  96  98  100]  ;  '/.  kPa 


'/,  Sea-level  fuel  flow  look-up  table  fflow  =  fflow(RPM,  MAP) 
’/.  RPM  ->  rows,  MAP  ->  columns 


FuelFlow  =  [ 

31  32  46  53  55  57  65  73  82 
40  44  54  69  74  80  92  103  111 
50  63  69  92  95  98  126  145  153 
66  75  87  110  117  127  150  175  190 
83  98  115  143  148  162  191  232  246 
93  102  130  159  167  182  208  260  310 
100  118  137  169  178  190  232  287  313 

104  126  151  184  191  206  253  326  337 

123  144  174  210  217  244  321  400  408 


]  ;  '/.  g/hr 

y.  Sea-level  power  look-up  table  P  =  P(RPM,  MAP) 
y,  RPM  ->  rows,  MAP  ->  columns 
Power  =  [ 


18.85  47.12  65.97  67.54  69.12  67.54  67.54  69.12  86.39 
59.38  98.96  127.55  149.54  151.74  160.54  178.13  200.12  224.31 
93.83  149.54  187.66  237.5  249.23  255.1  307.88  366.52  398.77 
109.96  161.27  245.57  307.88  326.2  351.86  421.5  491.14  531.45 
164.93  245.04  339.29  438.25  447.68  494.8  565.49  673.87  772.83 
181.58  245.67  389.87  496.69  528.73  571.46  662.25  822.47  993.37 
184.31  293.74  403.17  535.64  570.2  622.04  748.75  956.09  1059.76 
163.36  276.46  420.97  565.49  609.47  691.15  860.8  1130.97  1193.81 
124.62  249.23  417.83  586.43  645.07  762.36  996.93  1246.17  1429.42 
] ;  y.  W 

y,  Sea-level  pressure  and  temperature  at  which  the  data  above  is  given 

pSL  =  102300;  '/,  Pa 

TSL  =  291.15;  '/.  deg  K 

y.  Engine  shaft  moment  of  inertia 

Jeng  =  0.0001;  '/.  kg*m"2 


y.y,y.  inertia  •/.•/.•/. 

y,  Empty  aircraft  mass  (zero-fuel) 
mempty  =  8.5;  '/,  kg 

y,  Gross  aircraft  mass  (full  fuel  tank) 
mgross  =  13.5;  ’/.  kg 
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'/,  Empty  CG  location  [x  y  z] 

CGempty  =  [0.156  0  0.079]  ;  */.  m 
Gross  CG  location  [x  y  z] 

CGgross  =  [0.159  0  0.090]  ;  */.  m 
*/,  Empty  moments  of  Inertia  [Jx  Jy  Jz  Jxz] 
Jempty  =  [0.7795  1.122  1.752  0.1211];  */.  kg*ni~2 
'/,  Gross  moments  of  inertia  [Jx  Jy  Jz  Jxz] 
Jgross  =  [0.8244  1.135  1.759  0.1204];  */,  kg*m-2 


OTHER  SIMULATION  PARAMETERS  tVI. 

'/,  WMM-2000  date  [day  month  year] 
dmy  =  [13  05  2002] ; 

A. 2  Linearized  Models 

Linear  models  of  the  Aerosonde  were  obtained  using  the  linearization  script  aerosonde_trim .  m  included  with 
the  Aerosim  blockset.  The  flight  condition  input  to  the  script  was  Airspeed  of  25  m/s,  Altitude  of  1000m, 
fuel  mass  of  2  Kg,  and  straight  and  level  flight.  The  script’s  output  follows: 


Finished.  The  trim  results  are: 
INPUTS : 

Elevator  =  -0.0759 
Aileron  =  -0.0083 
Rudder  =  -0.0010 
Throttle  =  0.7075 


STATES : 

u  = 

24.96  m/s 

V  = 

0.01  m/s 

w  = 

1.41  m/s 

p  = 

0.00  deg/s 

q  = 

-0.00  deg/s 

r  = 

0.00  deg/s 

phi  = 

-0.02  deg 

theta 

=  3.24  deg 

psi  = 

-0.11  deg 

Alt  = 

1000.00  m 

Fuel  =  2.00  kg 

Engine  =  5209  rot/min 

OUTPUTS : 

Airspeed  =  25.00  m/s 

Sideslip  =  0.02  deg 

AOA  =  3.24  deg 

Bank  =  -0.02  deg 

Pitch  =  3.24  deg 

Heading  =  359.89  deg 
Altitude  =  1000.00  m 

Extracting  aircraft  linear  model. . . 


Longitudinal  Dynamics 


State  vector:  x  = 
Input  vector:  u  = 
Output  vector:  y  = 
State  matrix:  A  = 
-0.2205  0.5420 

-0.5523  -4.1290 

0.4370  -4.4992 

0  0 

0.0566  -0.9984 

32 . 0796  1 . 8177 


[u  w  q  theta  h  Omega] 
[elevator  throttle] 
[Va  alpha  q  theta  h] 


-1.3926 

-9.8121 

24.4105 

-0.5560 

-4.7625 

0 

1.0000 

0 

0 

24.9997 

0 

0 

-0.0001  0.0107 

0.0010  0 

0.0000  -0.0083 

0  0 

0  0 

-0.0383  -3.1132 


Control  matrix:  B  = 


0.3384  0 

-2.3488  0 

-32.4992  0 

0  0 

0  0 


0  301.2339 


Observation  matrix:  C  = 
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0.9984 

0.0566 

0 

0 

0 

0 

-0.0023 

0.0399 

0 

0 

0 

0 

0 

0 

1 . 0000 

0 

0 

0 

0 

0 

0  1, 

.0000 

0 

0 

0 

0 

0 

0 

1 . 0000 

0 

Eigenvalue : 

-4.4438  +/- 

10.5023  i 

Damping  =  0.3897,  natural  frequency  =  11.4038  rad/s,  period  =  0.5983  s 

Eigenvalue:  -3.2169 
Time  constant  =  0.3109  s 
Eigenvalue:  -0.0600  +/-  0.5322  1 

Damping  =  0.1121,  natural  frequency  =  0.5356  rad/s,  period  =  11.8050  s 

Eigenvalue:  -0.0007 

Time  constant  =  1526.9361  s 

Lateral-directional  Dynamics 


State  vector:  x  =  [v  p  r  phi  psi] 
Input  vector:  u  =  [aileron  rudder] 
Output  vector:  y  =  [beta  p  r  phi  psi] 
State  matrix:  A  = 


-0.6382 

1.4143 

-24.9597 

9.8121 

0 

-4.2032 

-20.6894 

9 . 9576 

0 

0 

0.6818 

-2.6836 

-1.0407 

0 

0 

0 

1.0000 

0 . 0567 

-0.0000 

0 

0 

0 

1.0016 

-0.0000 

0 

Control  matrix:  B  = 
-1.3638  3.4810 

-119.7422  2.1545 

-4.7213  -21.9948 
0  0 
0  0 

Observation  matrix:  C  = 


0.0400 


0 


0 


0 


0 
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0 

1.0000 

0 

0 

0 

0 

0 

1 . 0000 

0 

0 

0 

0 

0 

1.0000 

0 

0 

0 

0 

0 

1.0000 

Eigenvalue:  -19.8687 
Time  constant  =  0.0503  s 
Eigenvalue:  -1.2766  +/-  5.8249  1 

Damping  =  0.2141,  natural  frequency  =  5.9631  rad/s,  period  =  1.0787  s 

Eigenvalue :  0 . 0535 

Time  constant  =  -18.6855  s 
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Appendix  B 

SIMULINK  MODELS 

B.l  Simulink 

B.1.1  Description  from  MathWorks  [3] 

Simulink  is  a  platform  for  multidomain  simulation  and  Model- Based  Design  of  dynamic  systems.  It  provides 
an  interactive  graphical  environment  and  a  customizable  set  of  block  libraries  that  let  you  accurately  design, 
simulate,  implement,  and  test  control,  signal  processing,  communications,  and  other  time-varying  systems. 

B.l. 2  Settings 


For  my  simulations  in  Simulink,  I  used  the  Runge-Kutta  solver  with  a  fixed  step  size  of  0.02  seconds. 
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B.2  Simulink  Model  for  the  Square  Wave  and  Circular  Patterns 


Main  Aerosonde  Simulink  model  for  the  square  wave  and  circular  patterns 


Square  wave:  Path  following  block 


Square  wave  and  Circle:  Circular  pattern  block 


Square  wave  and  Circle:  Calculating  x  for  circular  path 


Calculating  A’s  for  circular  path 
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Square  wave  and  Circle:  Calculating  As  for  circular  path 


radius 
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id  Circle;  Quadrant  check  for  circular  pattern 


Square  wave  and  Circle:  Capture  s  value  for  circular  path 
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pattern 


r 
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Square  wave  and  Circle:  Segment  3  of  the  square  wave  Square  wave  and  Circle:  Segment  4  of  the  square  wave 


Action  Port 
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Square  wave  and  Circle;  Segment  7  of  the  square  wave  Square  wave  and  Circle:  Segment  8  of  the  square 


Action  Port 
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Square  wave  and  Circle;  Calculation  of  lengths  a  and  b 


Square  wave  and  Circle:  Calculation  for  corners  2  and  3  of  the  square  wave  pattern 
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Main  Aerosonde  Simulink  model  for  the  simple  circular  pattern 


Path  following  block  for  the  simple  circular  pattern 


definition  block  for  the  simple  circular  pattern 


B.4  Simulink  Model  for  the  Standoff  Pattern 


Main  Aerosonde  Simulink  model  for  the  standoff  pattern 
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Path  following  block  for  the  standoff  pattern 
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Calculations  for  segment  lengths  for  the  standoff  pattern 


Us  feedback  block  for  the  standoff  pattern 


Action  Port  Action  Pott 
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Segment  3  of  standoff  pattern  Segment  4  of  standoff  pattern 


Action  Port 


80 


Segment  7  of  standoff  pattern  Segment  8  of  standoff  pattern 


